#!/usr/bin/env python
import roslib; roslib.load_manifest('nidaqIO');
import rospy
from nidaqIO.msg import Doubles

rospy.init_node("jointIOTester");
pub=rospy.Publisher("diego/writeraw", Doubles)

rospy.sleep(2)

r=rospy.Rate(.5);
a=[3]*88;
pub.publish(data=a);
r.sleep()
dv=1;
for i in range(2):
    a[42] = 5+dv;
    a[43] = 5-dv;
    print a[42:44]
    pub.publish(data=a);
    dv = - dv
    r.sleep()
pub.publish(data=[3]*88);
